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I.   INTRODUCTION 

Passive  localization  and  tracking  techniques  are  of 
interest  in  a  variety  of  microcomputer  based  surface/ 
subsurface  radar  applications. 

Because  a  significant  portion  of  the  cost  of  building 
or  maintaining  a  warship  is  the  electronics  in  its  sensor 
and  weapon  system,  and  because  a  great  amount  of  time  and 
manpower  is  employed  in  performing  simple  but  important 
tasks /  microcomputers  offer  the  potential  to: 

(1)  Reduce  the  cost  of  digital  systems, 

(2)  Perform  some  complex  functions  at  remote  stations, 
relieving  the  congestion  at  larger  central  computer 
facilities,  and 

(3)  Perform  functions  currently  handled  by  watch  personnel, 
thus  reducing  the  manning  requirements  of  watch 
sections . 

An  example  of  this  is  the  problem  of  manual  tracking  of  radar 
contacts  and  the  solution  of  Maneuvering  Board  Problems. 

It  is  the  purpose  of  this  study  to  demonstrate  than  an 
alternate  approach  to  the  solution  of  the  problems  mentioned 
above  can  be  developed  and  implemented  by  using  a  micro- 
computer system,  while  at  the  same  time  maintaining  a  human 
engineered  user  interface. 
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II.   FORMULATION  OF  THE  PROBLEM 

A.   PREFACE 

For  Naval  ships  not  equipped  with  Naval  Tactical  Data 
Systems  (NTDS) ,  operations  performed  by  the  Combat  Infor- 
mation Center  (CIC)  during  a  normal  peacetime  watch  include 
manual  tracking  of  radar  contacts  and  solution  of  maneuvering 
board  problems.   The  environment  emulated  by  the  Intel 
Intellec  Microcomputer  Development  System  (MDS)  provides  a 
data  subset  of  the  NTDS.   The  subset  of  information  is 
provided  via  radar  interface  to  the  MDS  System. 

The  interface  between  the  microcomputer  and  the  surface 
radar  was  not  constructed  to  due  cost,  time  and  manpower 
constraints . 

The  scenario  of  the  study  was  limited  to  the  development 
of  a  Kalman  Filter  bearing-only  tracking  algorithm  for  the 
Intel  Intellec  MDS  microcomputer  system  and  Intel  SBC-310 
High-Speed  Mathematics  Unit  Performance.   Simulation  of  the 
circuitry  is  necessary  to  interface  with  the  AN/SPS-10 
surface  search  radar. 

The  parameters  for  the  AN/SPS-10  surface  search  radar 
were  used  for  computations  requiring  specific  radar 
parameters.   This  radar  was  chosen  because  all  information 
regarding  the  radar  is  available  at  the  Naval  Postgraduate 
School. 
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A  Kalman  filter  was  selected  because  it  minimizes  the 
estimation  error  in  a  well  defined  statistical  sense  and 
most  complex  calculations  of  the  tracking  filters  typically 
used  for  bearing-only  radar  tracking  that  is  easily 
computable  with  a  microcomputer  system. 

The  system  input/output  parameters  are  shown  in 
Figure  1. 

B.   TYPICAL  COMBAT  INFORMATION  CENTER  OPERATIONS 

During  normal  peacetime  steaming,  the  CIC  watch  team 
may  consist  of  from  two  to  ten  or  even  more  personnel, 
depending  on  the  size  of  the  ship  as  well  as  on  the  complexity 
of  the  equipment  being  used. 

Among  the  problems  that  are  normally  solved  by  CIC 
personnel,  special  mention  needs  to  be  made  of  those  of 
plotting  contacts  and  the  determination  of  parameters  such  as 
course,  speed  and  closest  point  of  approach  (CPA)  of  those 
contacts.  This  is  a  tedious  and  error-prone  task;  it  often 
requires  most  of  the  time  and  effort  of  the  CIC  team  and  it 
is  vitally  important  to  the  safety  of  the  ship.   This  had 
led  to  the  installation  of  equipment  to  reduce  the  amount 
of  workload  in  the  CIC  while  at  the  same  time  improving  the 
reliability  of  the  constant  information  provided  to  the 
bridge.   This  equipment  includes  dead  reckoning  devices  and 
NC2  plotter. 

1.   Maneuvering  Board  Plotting  Sheets 

The  maneuvering  Board  Plotting  Sheets  (H.O.  2665-10) 
have  been  prepared  in  order  to  facilitate  the  solution  of 
a  ship's  relative  movement  problem. 
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Figure    1.       SYSTEM    INPUT/OUTPUT    PARAMETERS 


13 


The  primary  responsibility  of  CIC  is  to  provide 
information  and  recommendations  on  the  tactical  situations, 
such  as  contact  course,  speed,  CPA  information,  are  defined 
using  the  "Maneuvering  Board"  plotting  sheets.   But  the  use 
of  the  Maneuvering  Board  requires  some  pracice,  also  it 
requires  the  complete  attention  of  one  person  during  the 
CIC  operation. 

2.   Dead-Reckoning  Equipment 

This  equipment  maintains  a  continuous,  up  to  the 
minute,  geographic  plot  of  own  ship's  plot  in  the  CIC. 

The  Dead-Reckoning  System  consists  of  the  following 
basic  components:   (1)  Dead-Reckoning  Analyzer  (DRA) ; 
(2)  Dead-Reckoning  Indicator  (DRI) ;  and  (3)  Dead-Reckoning 
Time  (DRT) .   Course  and  speed  inputs  of  own  ship  are  fed 
into  the  DRA  from  Gyrocompass  and  pitometer-log  and  then  to 
the  DRT,  where  they  cause  a  movable  source  of  light  to  trace 
the  ship-track  continuously. 

In  all  systems  as  mentioned  above  the  target's  rela- 
tive position  measurements  are  obtained  from  radar  repeater 
and  plotted  on  the  systems  which  are  read  to  be  used.   The 
range  measurement   accuracy  is  at  best  ±  20  yards  and 
bearing  measurement  accuracy  is  ±  1  degrees  with  a  well 
calibrated  repeater  and  a  well  trained  operator.   The  own 
ship  speed  and  course  are  used  to  determine  the  own  ship's 
velocity  vector.   The  course  and  speed  of  own  ship  may  vary 
±  1  degree  and  ±  1  knot  depending  on  the  helmsman,  weather 
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conditions  and  the  ship  instruction.   The  combined  result 
and  the  manual  solution  will  cause  ±  5  degrees  in  course 
and  ±  3  knots  in  speed  of  the  target  information.   Also 
the  major  disadvantage  of  the  manual  solution,  in  addition 
to  its  poor  accuracy,  is  the  time  required  to  obtain  the 
solution  and  the  inability  to  obtain  solutions  of  either 
the  target  or  own  ship  maneuvers  between  radar  position 
measurements,  typically  3  or  more  minutes  apart. 

C.   MICROPROCESSOR  TECHNOLOGY 

Recent  advances  in  large  scale  integration  (LSI)  semi- 
conductor process  technology  have  made  possible  substantial 
reductions  in  the  cost  and  size  of  digital  logic  circuits. 
Microprocessors  represent  a  very  remarkable  achievement 
of  engineering  ingenuity  and  industrial  know-how  at  their 
best. 

Since  1973,  the  year  in  which  Intel  Corporation  shipped 
the  first  8080,  8-bit  N-channel  microprocessor,  a  number  of 
manufacturers  have  developed  similar  products  and  because 
of  this  competition  prices  have  been  drastically  lowered. 
With  hardware  and  software  system  development  costs  as  they 
are,  much  micro  work  is  done  on  a  custom  basis.   The  primary 
advantage  of  microcomputer  based  systems  is  to  have 
specialized  and  dedicated  equipment  solving  specific 
problems . 

The  microprocessor  families  are:   (1)  4-bit  machine; 
(2)  8-bit  machine;  (3)  16-bit  machine;  and  (4)  bit-slices 
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architecture.   16-bit  microprocessor  is  the  best  solution 
for  our  concern  of  tracking  problem.   But  Intel's  8080  was 
selected  as  an  8-bit  microprocessor  and  programmed  for 
double  precision  arithmetic  to  perform  Kalman  Filter 
algorithms/   because  of  its  lower  cost  and  availability  at 
the  Naval  Postgraduate  School  with  all  its  hardware  and 
software  support  devices. 

D .   SCENARIO 

In  order  for  a  ship  to  maintain  operational  readiness 
as  a  unit  of  a  task  force,  it  must  be  aware  of  the  current 
operational  environment.   The  operational  environment  is 
defined  as  the  surface/subsurface  contact  profiles  in  the 
geographic  area  of  interest.   The  contact  profile  consists 
of  friendly,  hostile,  and  unknown  contacts  with  associative 
contact  characteristics.   Contact  characteristics  are  such 
measurements  from  radar,  range  and  bearing  to  accurately 
determine  the  course  and  speed  of  a  radar  contact.   If  the 
radar  measurements  were  perfectly  accurate  and  the  target 
had  zero  acceleration,  then  the  tracking  problem  would  be 
velocity  vector  problem  as  shown  in  Figure  2,  velocity 
vector  and  contact  relative  motion  plot  as  shown  in  Figure  3. 
But  the  radar  bearing  and  range  measurements  on  any  scan  have 
errors  which  are  a  function  of  the  radar  system  and  the 
received  signal  to  noise  ratio.   The  measurement  errors  will 
be  discussed  after  defining  the  Kalman  Filter  parameters. 
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Figure  2.   GEOGRAPHIC  PLOT  OF  CONTACT  AND  OWN  SHIP  MOTION 
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Figure  3.   VELOCITY  VECTOR  AND  CONTACT  RELATIVE  MOTION  PLOT 
(Own  Ship  assumed  at  the  origin.) 
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The  contact  motion  on  a  X,Y  coordinate  system  can  be 
approximated  by  linear  dynamic  system.   The  target  dynamics 
can  be  represented  in  a  matrix  form  as  shown  below  to  define 
the  sample  data  system  such  as  a  search  radar  where  the 
measurements  are  taken  once  each  antenna  rotation 
(Reference  13) 
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vehicle  state  vector  at  scan  n, 

E/W  position  of  the  vehicle, 

E/W  velocity  of  the  vehicle, 

N/S  position  of  the  vehicle, 

N/S  velocity  of  the  vehicle, 

interval  between  observations, 

acceleration  acting  upon  the  vehicle  from 
scan  (n)  to  (n+1) . 
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A  Kalman  filter  is  a  common  optimal  filtering  technique 
for  estimating  the  state  of  a  linear  system.   It  is  selected 
to  implement  the  tracking  problem  because  it  is  computa- 
tionally the  most  demanding  technique  in  our  concern.   The 
details  of  the  Kalman  filter  will  be  analyzed  in  Chapter  IV. 
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III.   SYSTEM  DESIGN  CONSIDERATIONS 

A.   HARDWARE  DESIGN  CONSIDERATIONS 

Microprocessors,  in  general,  are  not  complete  computers, 
but  Central  Processor  Units  (CPU)  implemented  with  one  to 
ten  large-scale  integrated-circuit  chips.   Large-scale 
integration  (LSI)  chips  are  comprised  of  1,000  or  more 
gates;  many  LSI  chips  hold  over  6,000  gates  or  a  "complete 
central  processor." 

The  word  "micro-computer"  refers  to  a  small  stored 
program  computer  comprising  memory  and  input/output  circuits 
together  with  a  microprocessor  CPU. 

Interface  design  and  programming  make  the  mass-produced 
microcomputers  into  new  special-purpose  dedicated  machines. 

The  Intellec  Microcomputer  Development  System  (MDS)  is 
a  complete,  coordinated  computer  system  designed  around 
Intel's  8080  microprocessor.   The  MDS  has  a  2  microsecond 
instruction  cycle,  a  repertoire  of  72  powerful  instructions, 
unlimited  subroutine  nesting,  and  a  versatile  interrupt 
scheme. 

The  MDS  was  selected  because  of  its  8080  microprocessor, 
its  memory  capabilities,  its  interrupt  mechanism,  and  its 
extended  I/O  capabilities.   Also,  the  selection  of  the 
Intel  Microcomputer  Development  System  (MDS)  was  made  for 
this  theis  because  of  its  immediate  availability  at  the 
Naval  Postgraduate  School. 
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A  Datamedia  Elite  2500  Video  Terminal  was  chosen  to 
present  alphanumeric  information  because  its  features 
include:   (1)  Editing  and  roll  operation  modes;  (2)  50  to 
3600  baud  programmable  speed  transmission;  (3)  protected 
fields,  (4)  computer  derived  or  high  light  field  (blink); 
(5)  addressable  cursor. 

Because  of  the  computation  of  Kalman  filter  algorithms, 
floating-point  calculation  required,  an  SBC-310  high-speed 
math  unit,  developed  by  Intel  Corporation,  was  incorporated. 
In  performing  high  speed  mathematical  functions,  the  Math 
Unit  acts  as  an  intelligent  processor,  performing  a  reper- 
toire of  14  arithmetic  functions  and  at  least  an  Oder  of 
magnitude  faster  than  comparable  software  routines.   Why 
it  is  to  selected  to  perform  the  algorithms  will  be  discussed 
in  Section  C  of  this  Chapter,  and  Figure  4  shows  the  final 
configuration  of  the  equipment  used  in  developing  this 
thesis.   Also,  start-up  procedures  for  the  system  were  listed 
in  Appendix  B. 

B.   SOFTWARE  DESIGN  CONSIDERATIONS 
1 .   Language  Selection 

Choice  of  the  computer  language  to  be  used  was 
partially  dependent  upon  the  hardware  configuration. 
PL/M-80  was  preferred  as  a  programming  language  to  be  used, 
after  selecting  MDS  hardware  system,  to  the  assembly  language 
because  of  its  ease  as  programming  and  immediate  availability. 

PL/M-80  is  a  high  level  language  developed  by  Intel 
Corporation  and  esigned  especially  for  system  and  applications 
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Figure  4.   EQUIPMENT  CONFIGURATION 

programming  for  the  Intel  8080  microprocessor.   It  is  a 
block  structured  language  which  speeds  the  microprocessor 
program  development  by  relieving  the  programmer  of  the 
tedious  task  of  memory  and  register  management. 

ISIS-II  disk  operating  system  also  developed  by  Intel 
Corporation  for  the  Intellec  MDS  system  has  a  resident 
PL/M-80  compiler  which  has  been  very  useful  during  the 
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implementation,  debugging  and  testing  the  program.   The 
PL/M-80  compiler  accepts  the  statements  as  input  and  produces 
a  machine-code  program  module  as  output. 

PL/M  statements  are  divided  into  two  basic  categories 

1.  DECLARE  and  PROCEDURE  statements. 

2.  EXECUTABLE  statements,  which  are  all  other  than  declare 
and  procedure  statements. 

EXECUTABLE  statements  cause  machine  code  to  be  generated. 
DECLARE  statements  cause  variables  to  be  defined  associated 
with  objects  and  PROCEDURE  capability  permits  program  to 
be  constructed  in  a  modular  fashion,  which  has  numerous 
advantages  including  efficiency  of  coding,  readability  of 
programs,  ease  of  debugging  and  possibility  of  using  the 
same  procedure  in  more  than  one  program  (Ref.  6)'. 
2.   Floating  Point  Arithmetic 

Floating  point  arithmetic  is  required  because  range 
of  numbers  to  be  represented  is  large  and  sometimes  unpre- 
dictable, especially  in  the  Kalman  filter  algorithm.   In 
this  algorithm  when  the  time  concern  to  use  a  floating  point 
arithmetic  is  disadvantageous,  because  it  needs  additional 
subroutines  or  hardware,  but  when  the  accuracy  concern  we 
must  use  it  in  our  programming. 

In  selecting  floating-point  formats,  the  primary 
considerations  are  word  size  and  the  radix  of  the  arithmetic. 
In  much  of  the  literature,  24-bit  word  size  is  regarded  as 
too  small  for  scientific  computation.   The  Intel  standard 
for  floating  point  arithmetic  has  been  adopted  to  apply  to 
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all  general  purpose  products  including  software  systems, 
and  components.   Such  as  FPAL  (Floating-Point  arithmetic 
library)  for  the  8080  and  Math  Board  (SBC-310)  made  of  series 
3000  bit  slices  have  already  been  produced  using  this 
standard. 

As  the  floating-point  arithmetic  formats  concern 
there  are  two  standard  formats  which  have  been  accepted 
from  Intel  (Ref.  12):   (a)  32-bit  short  precision  word; 
(b)  62-bit  long  precision  word.   The  32-bit  short  precision 
word  format  with  binary  radix  was  chosen  because  of  the  hard- 
ware consideration  by  selectin  the  MDS  system  and  8080 
microprocessor  with  SBC-310  high  speed  mathematics  unit  was 
the  fastest  and  available  at  the  Naval  Postgraduate  School. 

Comparison  will  be  done  next  with  its  compatibles: 

(1)  AM9511  Arithmetic  processing  unit  (Advanced 
Micro  Devices,  Inc.) 

(2)  8080/8085  Floating-Point  Arithmetic  Library  (FPAL) 
(Intel  Corporation) 

(3)  24-bit  special  floating  point  (Ref.  11) 

(4)  SBC  310  High  Speed  Mathematic  Unit  (Intel 
Corporation) . 

a.   AM9511  Arithmetic  Processing  Unit 

The  AM9511  is  a  monolithic  MOS/LSI  device  which 
provides  high  speed,  16  and  32  bit  fixed  and  32  bit  floating- 
point arithmetic,  plus  a  group  of  transcendental  derived 
functions,  control  and  conversion  commands. 

The  AM9511  APU  is  contained  within  a  single 
dual-in-line  24  pin  chip  as  described  in  detail  in  Ref.  3. 
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The  distinctive  characteristics  of  the  AM9511 
APU  include: 

-  Fixed-point  16  and  32  bit  operation 

Floating-point  32  bit  operation 

Binary  data  formats 

Basic  add,  subtract,  multiply  and  divide 

Trigonometric  sine,  cosine,  tangent 

Inverse  trigonometric  arcsine,  arccosine,  arctangent 

Square  roots 

Logarithms  base  on  10  and  e 

Exponentiation 

Float-to-fixed  and  f ixed-to-f loat  conversions 

stack  oriented  operand  storage 

DMA  or  programmed  I/O  data  transfers 

General  purpose  8-bit  data  interface. 
Data  Formats: 

All  fixed-point  operands  and  results  are 
represented  as  binary  two's  complement  integer  values.   The 
16  bit  format  can  express  numbers  with  a  range  of  -32,7  68 
to  +32,767.   The  32  bit  format  can  express  numbers  with  a 
range  of  -2,147,483,648  to  +2,147,483,647. 

The  floating  point  format  uses  a  32  bit  word 
width  as  shown  in  Figure  5.   The  most  significant  bit  (bit  31) 
indicates  the  sign  of  mantissa.   The  next  seven  bits  form 
the  exponent  and  remaining  24  bits  form  the  mantissa  value. 
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MANTISSA  SIGN 
EXPONENT  SIGN 

EXPONENT  MANTISSA 

m         i  i 


3130         24  16  18 


Figure  5.   FLOATING-POINT  FORMAT  FOR  AM9511  APU 

The  exponent  of  the  base  2  is  an  unbiased  two's 
complement  number  with  a  range  of  -64  to  +63.   The  mantissa 
is  a  sign-magnitude  number  with  an  assumed  binary  point 
just  to  the  left  of  the  most  significant  mantissa  bit  (bit  2) 
All  floating  point  values  must  be  normalized  which  makes 
bit  23  always  equal  to  1  except  when  representing  a  value  of 
zero.   The  number  zero  is  represented  with  binary  zeros  in 
all  32  bit  positions. 

The  operation  of  the  APU  is  described  in  Ref .  3 
in  detail  with  the  command  formats  and  their  descriptions. 
The  AM9511  interested  commands,  its  clock  cycles  and 
typical  execution  times  for  three  different  clock  frequencies 
such  as  2  MHz,  3  MHz  and  4  MHz  are  shown  in  Table  I. 
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TYPICAL  EXECUTION  TIMES 

COMMAND 
MNEMONIC 

CLOCK  CYa.ES 

AM9511 
(2  MHz) 

AM9511-1 
(3  MHz) 

AM9511-4 
(4  MHz) 

32-BIT  FIXED  POINT  OPERATIONS 

ADD 

(DADD) 

22-22 

10 

7 

5 

SUBTRACT 
(DSUB) 

38-40 

19 

13 

10 

MULTIPLY,  LOVJER 
(DMUL) 

184-210 

97 

65 

49 

MULTIPLY,  UPPER 
(DMUU) 

182-218 

91 

61 

46 

DIVIDE 
(DDIV) 

186-210 

98 

66 

50 

32-BIT  FLOATING-POINT  PRIMARY  OPERATIONS 

ADD 

(FADD) 

54-368 

27 

18 

14 

SUBTRACT 
(FSUB) 

70-370 

35 

24 

18 

MULTIPLY 
(FMUL) 

146-168 

73 

49 

37 

DIVIDE 
(FDIV) 

154-184 

77 

52 

38 

32-BIT  FLOATING-POINT  DERIVED  OPERATIONS 

SQUAREROOT 
(SORT) 

782-870 

391 

262 

200 

LOG  BASE  10 
(LOG) 

4474-7132 

2237 

1493 

1125 

LOG  BASE  e 
(LN) 

4298-6956 

2149 

1435 

1098 

Note:     All  time  values  are  specified  in  microseconds. 

Table    I.       AM9511    ARITHMETIC    PROCESSING    UNIT    COMMAND 
EXECUTION    TIMES 
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TYPICAL  EXECUTION  TIMES 

COMMAND 
MNEMONIC 

CLOCK  CYrTF.S 

AM9511 
(2  MHz) 

AM9511-1 
(3  MHz) 

AM9511-4 
(4  MHz) 

CONTINUATION  OF  32-BIT  FLOATING-POINT  DERIVED  OPERATIONS 

SINE 
(SIN) 

3786-4808 

1898 

1266 

950 

COSINE 
(COS) 

3840-4878 

1920 

1280 

960 

TANGENT 
(TAN) 

4894-5886 

2447 

1635 

1225 

ARCSINE 
(ASIN) 

6230-7938 

3115 

2080 

1560 

ARCCOSINF 
(ACQS) 

6304-8284 

3152 

2105 

1580 

ARCTANGFNT 
(ATAN) 

4992-6536 

2496 

1665 

1250 

EXPONENT 
(EXP) 

3784-4878 

1887 

1265 

949 

POWER 
(PWR) 

8280-12032 

4145 

2765 

2075 

32-BIT  DATA  AND  STACK  MANIPULATION  OPERATIONS 

FIXED-TO-FLQAT 
CONVERSION 
(FLTD) 

56-342 

28 

19 

14 

FLOAT-TO-FIXED 
CONVERSION 
(FXTD) 

20-336 

45 

30 

23 

FLOAT  POINT  SIGN 
CHANGE 
(CHSF) 

16-20 

8 

6 

4 

EXCHANGE 
(XCHF) 

26 

13 

9 

7 

Note:     All  time  values  are  specified  in  microseconds. 

Table    1    (Continuation) .      AM9511    ARITHMETIC   PROCESSING 
UNIT    COMMAND    EXECUTION    TIMES 
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b.   8080/8085  Floating-Point  Arithmetic  Library  (FPAL) 
The  FPAL  procedures  reside  in  object  code  module 
form  in  the  library  "FPAL. LIB"  on  the  Intellec  ISIS-II 
System  diskette.   They  are  self  contained  and  can  be  used 
in  component,  OEM-board,  or  Intellec  Microcomputer,  Develop- 
ment System.   It  contains  basic  floating  point  subroutines 
and  functions  (referred  to  generally  as  "procedures") . 
The  operations  provided  are: 

Addition,  subtraction,  multiplication,  division 

Value  comparison 

Conversion  between  decimal  and  binary  floating  point 
and  32  bit  signed  integer  formats 

A  default  error  handler  subroutine. 

For  all  operations  single  precision  format  is  used  and  in 

addition  to  these  operations,  a  number  of  procedures  are 

provided  to  deal  with  the  Floating  Point  Record  (FPR) .   This 

is  a  reserved,  18  byte  work  area  used  to  collect  status  and 

error  information,  and  as  an  accumulator  for  intermediate 

results.   The  procedures  supporting  the  FPR  perform  FPR 

initialization,  change  error  recovery  options,  check  the 

contents  of  FPR  fields,  and  pass  numbers  between  the  FPR 

and  memory. 

The  FPAL  also  includes  a  default  error-handler 

subroutine.   This  subroutine  is  called  when  an  invalid  number 

is  used  in  a  floating-point  operation  or  if  overflow, 

underflow,  or  division  by  zero  are  not  handled  by  an 

arithmetic  subroutine.   We  may  also  write  our  own  error 
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handler,  so  long  as  it  conforms  to  the  formats  described 
in  Reference  2. 

The  FPAL  can  be  used  by  assembly  langugages  or 
PL/M  programs. 

In  general,  the  following  steps  must  be  observed 
to  use  the  Floating-Point  Library: 

1)   An  area  of  memory  must  be  reserved  for  the  Floating- 
Point  Record  (FPR) . 

(2)  The  names  of  the  FPAL  procedures  must  be  declared  to 
be  "external". 

(3)  FPAL  procedure  references  must  be  imbedded  in  our 
source  code  where  appropriate. 

(4)  The  FPAL  procedure  used  by  our  program  must  be  linked 
to  our  object  file. 

(5)  If  we  want  to  use  the  FPAL  procedures  in  our  program, 
that  program  cannot  use  symbols  that  are  reserved  for 
FPAL  such  as  symbolic  names  beginning  with  a 
"commercial  at"  sign,  "@"  or  names  whose  second 
character  is  "Q"  or  "?". 

Floating  Point  Record  (FPR)  procedures, 
arithmetic  procedures,  error  handling  procedures,  and  inter- 
face to  FPAL  are  described  in  Reference  2  in  detail. 
Data  Formats: 

FPAL  procedures  operate  on  single-precision 
binary  numbers,  either  32-bit  integer  format  or  in  a  32-bit 
floating-point  format. 
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The  integer  format  recognized  by  the  FPAL  is  a 

positive  or  negative  (two's  complement)  32-bit  binary  number 

The  approximate  range  of  this  format  is  from  -2. 147x1 09  to 

9 
+2.147x10  .   Single-precision  formats  in  the  floating-point 

accumulator  and  8080  memory  areas  are  shown  in  Figure  6. 


s      e  f 


where  s  =  sign  bit 
e  =  exponent 
f  =  fraction  or  mantissa 

Figure  6.   SINGLE  PRECISION  FORMAT  FOR  FPAL 

The  three  fields  within   these  formats  are: 

s 1S  the  sign  bit.   Sign  magnitude  repre- 
sentation wehre  s  =  0  means  positive  and 
s  =  1  means  negative. 

e is  exponent  bits.   The  exponent  is  offset  by 

(2  -1) .   All  zeros  and  all  ones  in  the 
exponent  field  are  currently  reserved  for  the 
floating  point  zero  and  the  invalid  numbers 
described  above. 


32 


f is  fraction  bits.   When  the  exponent  is  nonzero, 

a  1  bit  is  assumed  at  the  left  of  the  fraction; 
the  binary  point  is  between  the  assumed  bit 
and  the  explicit  fraction  bit. 

The  number  base  for  the  FPAL  is  binary.   The 
value  of  a  given  binary  representation  can  be  formulated  as 


7 
(-1)S  2e"(2  "1) • (1.  +  .f) 


where  e  ^  0  and  e  ^  FF. 

When  overflow  or  underflow  occurs  during  FPAL 

operations,  the  correct  fraction  results  but  the  exponent 

is  "wrapped  around".   A  "wrapped  around"  exponent  is  defined 

to  be  e  ,  where  the  true  (offset)  exponent,  e ,  ,  can  be 
w  t 

derived  from  e   by  considering  an  expanded  range  of 
exponents  and 

g 

on  overflow      e.   =   e   -(3.2  -2) 

t      w 

g 

on  underflow     e.   =   e     (3.2  -2)  . 

t      w 

The  floating  point  arithmetic  library  (FPAL)  complete 
functions  and  execution  times  are  given  in  Table  2. 
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FPAL   Procedure 

Bytes 

Typical 

Execution 

Time 

Float. -Point  Add.    (FADD) 

463 

700 

Float. -Point  Subtract   (FSUB) 

463 

700 

Float. -Point  Multiply   (FMUL) 

404 

1500 

Float. -Point  Divide   (FDIV) 

342 

3600 

Conversion  from  decimal  float. -point 
nimber  to  binary   (FQFD2B) 

725 

not  given 

Cbnversion  from  binary  float. -point 
number  to  decimal    (FQFB2D) 

1585 

not  given 

Float-to-Fixed  Conversion    (FIXSD) 

178 

not  given 

Fixed- to-Float  Conversion   (FLTDS) 

139 

not  given 

Floating  Point  Compare    (FCMPR) 

159 

300 

floating  Pint  Test    (FZTST) 

56 

not  given 

floating  Point  Absolute   (FABS) 

36 

not  given 

Floating  Point  Negative   (FNBG) 

43 

not  given 

Note:      All    time   values    are    specified    in 
microseconds . 

Table  2.   8080/8085  FPAL  FUNCTIONS  AND  EXECUTION 
TIMES 
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c.  24-Bit  Special  Floating-Point  Arithmetic 
Software  Subroutines 

This  software  subroutine  has  been  written  in 

Reference  11  to  perform  the  floating-point  arithmetic.   But 

the  format  that  has  been  used  is  not  our  concern  and  not 

suitable  to  our  standards.   The  only  reason  it  was  mentioned 

here  is  to  show  how  slow  execution  times  it  has  even  with 

16-bit  mantissa.   Its  functions  and  execution  times  are 

given  in  Table  3 . 

d.  The  SBC  310  High-Speed  Mathematics  Unit 

The  SBC  310  High-Speed  Mathematics  Unit  is  a 
member  of  a  complete  line  of  Intel  SBC  8  0  system  expansion 
modules.   In  performing  high-speed  mathematic  functions, 
the  Math  Unit  acts  as  an  intelligent  processor  slaved  to 
one  or  more  SBC  80  computer  masters.   The  math  unit  performs 
its  repertoire  of  14  arithmetic  functions  an  order  of 
magnitude  faster  than  is  possible  with  software  routines. 

Its  functions  and  execution  times  are  shown 
in  Table  4  and  a  detailed  description  of  programming  infor- 
mation and  principles  of  operation  are  explained  in 
Appendix  A  because  it  was  selected  to  perform  this  thesis. 

Four  different  systems  and  their  features  have 
been  explained  individually  as  they're  chosen  to  be 
compared  in  the  beginning  of  this  section.   The  comparison 
among  the  SBC  310,  High-Speed  Math  Unit,  the  AM9511 
Arithmetic  Processing  Unit,  the  Floating-Point  Arithmetic 
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OPERATION  NAME 

MAX  EXECUTION  TIME 

24-Bit  Floating-Point  Addition 
(ADD) 

1300 

24-Bit  Floating-Point  Subtraction 
(SUB) 

1400 

24-Bit  Floating-Point 
Multiplication 

(MULT) 

3400 

24-Bit  Floating-Point  Division 
(DIV) 

4100 

24-Bit  Floating-Point  Comparison 
(COMPARE) 

800 

24-Bit  Floating-Point  Squareroot 
(SQRT) 

17,000 

24-Bit  Floating-Point  Cosine 
(TRIG  1) 

18,000 

24-Bit  Floating-Point  Sine 
(TRIG  2) 

18,000 

24-Bit  Floating-Point  Cos  and  Sine 
(TRIG  3) 

30,000 

24-Bit  Floating-Point  Arctangent 
(TRIG  4) 

19,000 

Note:   All  time  values  are  specified  in  microseconds. 

Table  3.   24-BIT  SPECIAL  FLOATING-POINT  ARITHMETIC 
OPERATIONS  NAME  AND  EXECUTION  TIMES 
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OPERATION  NAME 

OPERATION 
CODE 

TYPICAL 

EXECUTION 

TIME 

MAXIMUM 

EXECUTION 

TIME 

Fixed-Point  Multiply  (MIL) 

0 

15 

20 

Fixed-Point  Divide  (DIV) 

1 

26 

30 

Extended  Fixed  Point  Div.  (EDIV) 

E 

84 

100 

Float. -Point  Multiply  (FMUL) 

2 

84 

100 

Float. -Point  Divide  (FDIV) 

3 

92 

110 

Float. -Point  Add  (FADD) 

4 

33 

75 

Float. -Point  Subtract  (FSUB) 

5 

33 

75 

Float. -Point  Square  (FSQR) 

6 

84 

100 

Float. -Point  Square  Root  (FSQRT) 

7 

178 

205 

Fixed-to-Float.  Conversion  (FLTDS) 

8 

72 

100 

Float . -to-Fixed  Conversion  (FIXSD) 

9 

42 

85 

Float.  Point  Conpare  (FCMPR) 

A 

7 

7 

Float.  Point  Test  (FZTST) 

B 

7 

7 

Exchange  (EXCH) 

F 

4 

4 

Note:  All  time  values  are  specif: 

Listed  times  do  not  include 
MATH  UNIT  and  to  read  resuJ 
typically  20  microseconds. 

Led  in  microseconds. 

s  time  to  pass  arguments 
.ts  upon  completion;  this 

to  the 
;  is 

Table  4.   SBC-310  HIGH  SPEED  MATH  UNIT  FUNCTIONS  AND 
EXECUTION  TIMES 
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Library  (FPAL) ,  and  24-bit  Special  Floating-Point  Software 
execution  times  of  their  operations  are  shown  in  Table  5. 

The  AM9511  APU  has  the  fastest  and  SBC-310  High 
Speed  Math  Unit  has  the  second  fastest  execution  times. 
Also,  if  we  compare  the  cost  of  the  units,  the  AM9511  is 
only  $195  in  the  market  and  it  is  cheaper  than  SBC-310 
Math  Unit.   But,  when  the  purpose  of  this  thesis  concern, 
as  a  Kalman  Filter,  and  immediate  availability  at  the 
Naval  Postgraduate  School,  the  SBC  310  High-Speed  Math  Unit 
was  chosen  to  perform  the  arithmetics  of  the  Surface/ 
Subsurface  Bearing-Only  Tracking  Radar  algorithms. 

C.   PHILOSOPHY  OF  SOFTWARE  DESIGN 

The  system  was  designed  with  the  following  objectives: 

1)  Human  engineered  user  interface. 

2)  Capability  of  solving  maneuvering  board  problems 
using  Kalman  Filter  algorithms. 

3)  Capability  to  display  the  result  and  the  error 
performance  of  the  assumed  problem  definition. 

In  order  to  avhieve  these  objectives,  the  following 
modules  were  developed: 

a)   nINT$DATA":   This  module  contains  range  and  bearing 
information  of  selected  contacts  and  their  observation  time 
intervals  for  each  scan. 

b.   "MAIN$PR0G":   This  module  is  used  to  perform  the 
implementation  of  Kalman  filter  algorithms,  results  and 
error  calculations. 
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^^^s^  SYSTEM 

^V.   NAMES 
OPERATION   >v 

NAMES       \. 

TYPICAL  EXECUTION  TIMES 

SBC  310 
High  Speed 
Math  Unit 

AM9511 
Arithmetic 
Proc.  Unit 

FDAL 
(Software) 

24-Bit 
Special  F. P. 
Software 

32-bit  Fixed  Point  Operations 

FMUL 

- 

97 

- 

- 

DIV 

84 

98 

- 

- 

32-bit  Floating  Point  Operations 

FMUL 

84 

73 

1500 

3400 

FDIV 

92 

77 

3600 

4100 

FADD 

33 

27 

700 

1300 

FSUB 

33 

35 

700 

1400 

FSQR 

84 

- 

- 

- 

FSQRT 

178 

391 

- 

17,000 

Fixed-to-Float 
Conversion 

72 

28 

- 

- 

Float-to-Fixed 
Conversion 

42 

8 

- 

- 

FCEMPR 

7 

- 

300 

800 

SINE 

3800 

1898 

- 

18,000 

COSINE 

3800 

1920 

- 

18,000 

ARCTG 

5000 

2496 

- 

30,000 

Note:  All  time  values  are  specified  in  microseconds. 

Table  5.   COMPARISON  OF  FOUR  DIFFERENT  SYSTEMS  EXECUTION 
TIME  OF  OPERATION 
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c.  "DISPLAY":   This  is  used  to  display  the  result 
and  error  calculations  on  the  CRT. 

d.  "FLOATING$POINT":   This  module  is  used  to  perform 
all  the  necessary  floating-point  operations  and  to  calculate 
the  cosine  and/or  sine  of  a  given  angle  in  radians  and  the 
arctangent  of  the  ratio  of  two  input  parameters. 

The  whole  program  is  listed  in  Appendix  E.   The  formats, 
units  and  conversion  factors  used  in  the  program  are  shown 
in  Table  6.   The  Kalman  filter  will  be  described  in 
Chapter  IV. 
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FORMAT 

UNITS 

I/O 

INTERNAL 

I/O 

INTERNAL 

TIME 

XXXX . XX 

F.P. 

seconds 

same 

COURSE 

XXXX . XX 

F.P. 

degrees 

radians 

SPEED 

XXXX . XX 

F.P. 

knots 

n.mile/ 
sec . 

BEARING 

XXXX . XX 

F.P. 

degrees 

radians 

RANGE 

XXXX. XX 

F.P. 

yards 

nautical 
miles 

5  Character 

F.P Floatiner  Point  ReDresen-ation 

2025.3716  yards 
0.0174532925  radians 

1  nautical  mile/hour 
3.141593 

Table  6.   FORMAT,  UNIT  AND  CONVERSION  FACTORS  USED 
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IV.  KALMAN  FILTER 

A  two  dimensional  Kalman  tracking  filter  provides  a 
convenient  framework  for  determining  optimal  filter 
parameters  for  x,y  tracking  for  a  two-dimensional  radar 
measuring  range  R  and  bearing  8. 

A.   DISCRETE  KALMAN  FILTER  ALGORITHM 

The  vehicle  dynamics  can  be  represented  in  matrix  form 
as  stated  earlier. 


Z  ,,   =   $  Z   +   r  a  (Ref.  13) 

n+1        n        n 


where  Z  ,  $ ,  r  and  a  were  defined  in  Chapter  II. 
n  n  c 

The  discrete  form  of  a  Kalman  filter  rather  than 
continuous  form  is  appropriate  because  of  surface  search 
radar  antenna  rotation  results  in  scan  while  measurements 
of  the  contact  position.   The  matrix  form  of  the  observation 
equation  can  be  written  as 


w   =   HZ„  +  v  (Ref.  13) 

n       n    n 


where 


w 
n 


XTJn> 
m 

u  m 
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x  (n)  =  measured  x  coordinate  at  scan  n 
m 

y  (n)  =  measured  y  coordinate  at  scan  n 


10   0   0 
H   = 

0   0   10 


Z   =  Vehicle  state  vector  at  scan  n 
n 


v  (n) 
v   = 
n       v  (n) 

y 


v  (n)  =  random  noise  on  x  measurement  at  scan  n,  x  (n) 
x  m 

v  (n)  =  random  noise  on  y  measurement  at  scan  n,  y  (n) 
y                      2  2m 


Optimal  estimates  of  the  contact  state  vector  at 
scan  n,  Z   are  given  by 


Z    =   Z   +  K  (w   -  HZ  )  (Reference  13) 

n      n    n   n     n 


where 


Z   is  the  estimated  state  vector  at  scan  n, 
n 


Z    ■  .♦  Z'   , 

n        n-1 


(see  Chapter  II,  Section  D) 
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;  _,  =  Optimal  estimate  of  target  state  vector  at  scan  (n-1) 


and 


x  x 

n  n 

'i  * 

x  x 

z   =   .n        ,      z   =    n 

y            n  y 

y  y 

Jn  Jn 


Z   is  the  optimum  estimate  of  the  state  vector  after  the 
n  e 

measurement  w   is  processed 


Z    is  the  optimum  estimate  of  the  state  vector  before 

n  r 


the  measurement  w   is  processed 

n    r 


K   =   P  HT(HP  HT  +  R  )  1  (Reference  13) 

n      n     r      n 


K   is  the  gain  matrix  at  scan  n  and  computed  for  steady- 


state  as 

A 

XX 

A 
xy 

Kn  = 

B   /T 

XX 

B   /T 
xy 

A 
yx 

A 

yy 

B   /T 
yx 

B   /T 

yy 
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P    is  the  estimated  covariance  matrix  of  the  estimation 
n 

errors  prior  to  the  processing  run. 

R   is  the  covariance  matrix  for  the  observation  noise, 
n 


R 


n 


ax(n) 


2  f     s 
a   (n) 
xy 


a2  (n) 
xy 

a2(n) 

y 


where  using  the  polar  coordinate  system  shown  in  Figure  7 


x  =  R  sin 
m 


y   =  R  cos 
■^m 


y  (NORTH) 


(WEST) 


(EAST) 


(SOUTH) 


Figure  7.   COORDINATE  SYSTEM 
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The  elements  of  the  covariance  matrix  for  observation 
noise  are: 


2         2     2      2        2         2 

a   (n)   =  a    sin  9  +  R  (n)  cos   8  (n)  an 

x    V  r  g 


2  2     2  2        2         2 

a  _  (n)   =  a    cos   9  (n)  +  R  (n)  sin   8  (n)  a 


a   (n)  =   \   sin  28  (n)  [a  2  -  R2  (n)  a  2] 
xy       2  r  9 


2 
a    =   variance  of  the  range  measurement  noise 

2 

a.    =   variance  of  the  bearing  measurement. 

9 


R(n)  and  9 (n)  are  the  vehicle  range  and  bearing  at  scan  n. 
The  covariance  matrix  P   can  be  computed  recursively  as 


T        T 
P   ,   =   $  P   $    +   TQr  (Reference  13) 


with     P    =   (I  -  K  H)  P 
n  n    n 


where  P   is  the  covariance  matrix  of  estimation  error 
n 

after  processing  w  . 

2 

Q  =  a  and  it  is  the  variance  of  random  contact 

acceleration.   The  variance  of  contact  acceleration  must 
be  equal  and  independent  along  x  and  y  axis,  and  from  scan 
to  scan. 
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This  form  of  the  Discrete  Kalman  filter  is  valid  for 
our  contact  maneuver  problem.   But  the  solution  of  the 
equations  in  matrix  form  is  unnecessarily  complex  for  the 
microcomputer.   Therefore,  an  algebraic  solution  of  each 
element  in  the  matrix  form  of  equations  was  formulated. 
These  equations  are  listed  in  Appendix  D. 

B.   KALMAN  FILTER  PARAMETERS 

The  Kalman  Filter  performance  is  determined  by  three 

parameters: 

2 

1)  a0   -  Variance  of  the  range  measurement  error 

i\ 

2 

2)  aQ   -   Variance  of  the  bearing  measurement  error 

0 

2 

3)  a  Variance  of  the  contact  acceleration. 

a 

The  first  two  parameters  are  functions  of  the  selected  radar 
and  the  ship's  gyrocompass.   The  third  parameter  is  a 
function  of  the  contact  relative  motion  and  the  desired 
smoothness  of  the  output  data. 

In  order  to  solve  the  tracking  problem  and  figure  out 
the  parameters  of  the  Discrete  Kalman  Filter,  it  is  necessary 
to  make  measurements  of 

a.  Contact  Range, 

b.  Contact  Bearing, 

c.  Own  Ship's  Course, 

d.  Own  Ship's  Speed,  and 

e.  Time  of  the  observation. 


47 


It  is  assumed  that  all  noise  is  Gaussian  and  Received 
signal  to  noise  ratios  are  large  (>>1)  . 

The  minimum  performance  of  the  selected  radar  (AN/SPS-10) 
characteristics  are  listed  in  Appendix  C  and  the  video 
signal  to  noise  ratio  with  single  pulse  detection  is  given 
as 


P  .  G2  A2  a    lcTaR/5 

—  (Reference  8) 


N  3  4 

(4tt)  kT  F  B  L  R 
o  n  n  s 


where 


P  ,  =  peak  transmitted  power  (Watts) 
G   =  antenna  gain 

X        =   wavelength  (m) 

2 

a        =  radar  cross  section  of  contact  (m  ) 

a    =  attenuation  constant  of  propagation  medium  (dB/m) 

R   =  range  to  contact  (m) 

-23 

k   =  Boltzman's  constant  (1.23x10     joule/deg) 

T   =  standard  temperature  (280°K) 
B   =  receiver  noise  bandwidth  (Hz) 
L   =  system  losses. 


The  contact  range  is  determined  by  measuring  the  time 
required  for  a  radar  pulse  to  travel  to  and  from  the  contact 


R  -  Si 
R    2 
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where     c  =  speed  of  light 

t  =  elapsed  time  from  pulse  transmission  to 

pulse  detection 
R  =  range  to  contact. 

Threshold  detection  could  be  used  to  indicate  the 
occurrence  of  the  leading  edge  of  the  received  radar  video 
pulse.   Leading  edge  detection  is  selected  because  it 
eliminates  errors  resulting  from  variations  in  the  pulse 
width.   The  standard  deviation  of  range  error  is  given 
below  if  the  rise  time  of  the  pulse  is  limited  by  receiver 
bandwidth  B. 


a        =   yjj  (Reference  8) 

2B(2  §) 


The  contact  bearing  is  determined  by  measuring  the 
bearing  of  the  radar  beam  at  the  time  the  contact  video 
is  detected.   Using  beam  splitting  technique  to  estimate 
the  center  bearing  of  the  contact,  the  standard  deviation 
of  bearing  error  is 


1.069 

g_ 


172 

[Ng  <l>c] 
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where 

a    =   standard  deviation  of  bearing  error 

0 

9    =   two  way  beamwidth 

g 

S 
(j^)   =   signal  to  noise  ratio  at  center  of  beam 

c 
N   =   number  of  pulses  emitted  as  the  antenna  rotates 

g 

2V 

The  standard  deviation  of  range  error  and  bearing  error 
are  functions  of  the  video  signal  to  noise  ratio  that  is 
given  on  page  48  for  a  single  pulse  detection.   When 
considering  the  threshold  to  noise  ratio,  it  is  necessary 
to  define  both  the  desired  mean  time  between  false  alarms 
and  minimum  probability  of  detection  of  the  contact. 
Probability  of  false  alarms  is  given  by  Ref.  8  in  terms  of 
the  mean  time  between  false  alarms  and  the  IF  bandwidth  of 
the  receiver  as  shown  below. 


P  ! 


FA      T_.  BXTP 
FA   IF 


The  mean  time  between  false  alarms  is  a  function  of 
the  threshold  to  noise  power  ratio  and  the  receiver  IF 
bandwidth.   And  it  can  be  increased  if  the  tracking  system 
is  off  whenever  the  contact  is  not  in  our  selected  range. 
The  maximum  unambiguous  range  of  AN/SPS-10  Radar  is  129.6 
nautical  miles  and  for  example  50  nm  of  that  is  of  our 
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concern.   This  would  disable  the  measurement  circuitry 
61.4  percent  of  the  time  and  it  will  give  us  an  additional 
advanatage. 

The  mean  time  between  false  alarms  of  35.3  sec  (10  times 

the  mean  interval)  has  been  selected.   The  probability  of 

—  9  —8 

false  alarms  5.66x10    for  one  contact  and  1.93x10    for 

50  nm  of  our  interest  range.   And  this  leads  to  a  threshold 

to  noise  power  ratio  of  12.5  dB.   Also  the  reflected  radar 

signals  from  contact  will  fluctuate  due  to  cancellation 

and  reinforcement  of  the  waves  reflected  from  various 

positions  of  the  contact.   These  fluctuations  can  be  formed 

as  Swerling's  Case  I  and  additional  11  to  14  dB  will  be 

required  to  insure  a  probability  of  0.9  to  0.99  resepectively 

The  standard  deviation  for  bearing  and  range  can  be 
related  to  contact  range  and  cross  sectional  area  as  given 
in  Ref.  9.   Based  on  a  threshold  to  noise  ratio  of  12.5  dB 
and  interested  range  of  a  50  nm  the  standard  deviation 
of  the  radar  range  and  bearing  errors  will  be  14  0.2  yards 
and  0.2062  (0.003599  rad) ,  respectively. 

In  addition  to  radar  measurement  errors  also  there  are 
ship's  gyrocompass  and  pitometer  log  errors  which  come  from 
the  own  ship's  course  and  speed  measurements.   And  gyro- 
compass not  only  determines  own  ship  course  but  also  deter- 
mines the  true  bearing  of  the  radar  antenna.   It  is  assumed 
that  the  standard  deviation  of  own  ship's  gyrocompass 
error  is  0.1  degrees  (0.001745  rad)  and  standard  deviation 
of  own  ship's  pitometer  log  error  is  0.1  knots. 
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Therefore,  the  variance  of  bearing  error  is  equal  to 

2 

the  sum  of  the  radar  bearing  error  (0.0425  deg  ),  and  the 

2 

variance  of  the  own  ship's  gyrocompass  error  (0.01  deg  ) 

2 
leads  to  the  total  variance  of  bearing  error  0.0525  deg 

—  6     2 
or  15.998x10   rad  .   The  variance  of  range  error  is 

2 
0.004  8  nm  . 

The  variance  of  target  acceleration  parameter  is  the 

ability  of  the  filter  to  provide  the  closest  estimate  of 

a  contact's  position  and  velocity  for  a  moving  contact. 

It  is  good  to  allow  the  experienced  operator  to  choose  the 

variance  of  acceleration  parameter  to  be  used  with  each 

contact. 

C.   KALMAN  FILTER  INITIAL  CONDITIONS 

As  it  is  explained  before  the  Kalman  Filter  algorithms 
represent  the  recursive  calculations  of  the  optimal 
estimates  of  the  covariance  of  estimation  error  matrix  and 
the  contact  state  matrix.   The  initial  condition  of  the 
contact  state  matrix  is  equal  to  the  expected  value  of  the 
initial  state.   The  expected  values  of  the  initial  position 
elements  are  the  first  measurements: 

XQ   =   R(0)  sin  e (0) 

YQ   =   R(0)  cos  6 (0) 

The  expected  values  of  the  initial  velocity  elements  are 
zero. 
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The  initial  condition  of  the  covariance  of  estimation 
error  matrix  is  equal  to  the  covariance  of  error  of  the 
initial  state  estimate: 


P(0)   =   E[ZQ  -  Z(0)]  [Z(0)  -  Z(0)]T 


E[(Xo-XQ)2      0          0  0 

0        Et^n)2        °  ° 

.      2 

0           0       E[(Y0-YQ)  ]  0 

ooo  e[yq)2] 


P(0) 


The  time  required  for  the  Kalman  Filter  to  achieve 
a  steady-state  condition  is  very  sensitive  choosing  the 
closest  right  values  of  the  nonzero  elements  of  the  initial 
state  estimate  matrix.   They  were  chosen  to  be  brought  the 
contact  on  y-axis  as  an  initially  by  given  equations  in 
Reference  13. 
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V.   SYSTEM  DESCRIPTION 

The  description  of  the  system  is  divided  into  three 
major  areas:   hardware  dependencies,  system  characteristics, 
and  system  performance. 

A.   HARDWARE  DEPENDENCIES 

Because  of  hardware  equipment  that  was  selected  the 
following  hardware  dependencies  exist  in  the  current 
implementation  of  the  system: 

1.  The  system  utilizes  an  SBC-310  High-Speed  Mathematics 
Unit  to  perform  floating  point  arithmetic.   Although  as 
discussed  before  the  presence  of  this  math  unit  could  be 
avoided  by  replacing  its  functions  with  appropriate  software 
routines  performing  the  same  operations  using  the  same 
formats,  this  is  not  recommended  because  of  excessive  over- 
head that  would  result,  especially  with  regard  to  the 
execution  time.   Appendix  F  explains  how  the  Math  Unit  was 
actually  implemented. 

2.  The  system  depends  in  three  ways  on  the  type  of 
terminal  used.   The  serial  asynchronous  procedure  necessary 
to  communicate  between  CPU  and  the  terminal,  the  code  needed 
to  control  the  CRT's  functions,  and  the  general  features 

of  the  DATAMEDIA  Elite  2500  Video  Terminal  notably  the 
programmable  roll  mode,  the  setting  of  privileged  fields, 
the  capability  of  having  an  addressable  cursor,  and  the 
possibility  of  making  displayed  messages  blink. 
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3.   The  system  occupies  approximately  13K  bytes  of 
physical  memory  for  code,  and  approximately  3K  bytes  to 
be  used  for  variable  data,  therefore  a  configuration  of 
at  least  16K  bytes  of  RAM  is  necessary  to  execute  the 
system. 

B.   SYSTEM  CHARACTERISTICS 

As  it  was  established  before,  the  system  was  designed 
to  perform  basically  to  solve  the  maneuvering  board  problem 
finding  the  contact  speed  and  course. 

Due  to  interaction  capability  between  modules  as 
allowed  by  the  language  PL/M-80  through  the  use  of  attri- 
butes PUBLIC  and  EXTERNAL  for  the  procedures,  the  following 
list  was  written  in  order  to  show  interactions.   This  list 
shows  the  modules  which  have  procedures  called  by  the  ' 
listed  module. 


1. 

EXTER 

2. 

INT $ DATA 

3. 

MAIN$PROG 

4. 

DISPLAY 

a. 

NUMOUT 

b. 

DISPLAY$CRT 

c. 

CRT $ READ 

d. 

CHECK$YES$NO 

e. 

DISP$ERROR 

5. 

FLOAT ING$ POINT 

a. 

MUL 

b. 

DIV 

c. 

EDIV 

d. 

FMUL 

e. 

FDIV 

f . 

FADD 

g. 

FSUB 

h. 

FSQR 

i. 

FLTDS 

J- 

FIXSD 
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k.  FSQRT 

1 .  FCMPR 

m.  FZTST 

n.  COS$SIN 

O.  ARC $ TAN 

The  Module  "INT$DATA"  is  used  to  implement  the  radar 
measurements:   range  as  a  yard,  bearing  as  a  degree,  time 
of  measurements  as  a  second  and  their  interfaces  process 
the  system. 

The  "MAIN$PROG"  Module  used  to  perform  the  Kalman  filter 
algorithms,  computation  of  the  filtered  target  course  and 
speed,  display  of  the  result  and  error  performance. 

The  Module  "DISPLAY"  includes  the  display  procedures 
on  the  CRT 

The  "FLOAT ING$ POINT"  Module  is  used  to  perform  the 
floating  point  arithmetic. 

In  order  to  achieve  these  objectives,  a  bottom-up 
implementation  philosophy  was  chosen.   Because  of  the 
modular  design  encouraged  by  PL/M  80  and  ISIS-II,  it  was 
also  possible  to  map  the  different  levels  of  design  into 
corresponding  modules  of  software.   The  basic  idea  was  to 
encompass  all  functions  corresponding  to  a  level  of  design 
into  one  software  module  capable  of  performing  all  the 
necessary  functions. 

C.   SYSTEM  PERFORMANCE 

The  performance  of  the  Kalman  filter  was  evaluated  for 
maneuvering  contact.   The  own  ship  was  proceeding  on  a 
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steady  course  (000°)  North  and  at  a  fixed  speed  of  30  knots 
from  an  initial  position  at  the  origin  of  the  cartesian 
coordinate  system  as  shown  in  Chapter  II,  Figure  3.   The 
contact  was  heading  to   060°   true  (North/East)  by  36  knots 
and  its  initial  position  was   009.6°   (North/East),  37,800 
years  from  own  ship. 

The  scenario  has  been  made  to  change  the  contact 
course  and  speed  after  every  15  sets  of  measurements.   The 
approximate  problem  was  solved  on  the  maneuvering  board  and 
by  hand  calculator.   The  first  chance  has  been  made  for 
contact  course  and  speed  which  were  073°  (North/South)  true 
and  50  knots,  respectively,  then  second  reorientation  has 
been  made  to  328°  (North/West)  true  course  and  30  knots 
speed. 

The  accuracy  of  the  computed  course  and  speed  of  the 
contact  will  depend  on  the  tracking  system  parameters  and 
the  maneuverability  of  the  contact.   The  antenna  rotation 
rate  determines  the  mean  time  between  measurements,  which 
in  the  case  of  the  AS-1161/SPS  Antenna  equates  to  3.53 
seconds.   The  majority  of  surface  contacts  will  be  capable 

of  turning  radii  of  100-1000  yards,  velocities  of  0-50 

2 
knots,  and  acceleration  of  0-0.5  yards/sec  .   The  following 

2        2 

Kalman  Filter  measurement  parameters  (<r„   and  a   )  were 

r  e        r 

used  as  calculated  in  Chapter  IV,  Section  B. 

a  2   =   0.004  8  nm2 

a  2   =   15.988xl0"6  rad2  . 

y 
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The  Kalman  filter  initial  conditions  were  the  same  as 

those  discussed  in  Chapter  IV,  Section  C.   The  variance 

2 

of  contact  acceleration  (a   )  parameter  was  selected  as 

a 


2  2     4 

a     =   0.0004  run  /sec 
a 


Also  as  is  mentioned  before,  the  variance  of  contact 

2 

acceleration  (a_  )  parameter  is  an  independent  variable  and 

a 

it  is  a  compromise  between  the  user's  desired  smoothness 
of  the  output  data  and  the  ability  of  the  filter  to  provide 
the  closest  estimate  of  a  contact's  position  and  velocity. 

This  parameter  could  be  selected  by  enabling  one  of 
several  read-only  memories  (ROM)  containing  the  desired 
values.   The  particular  ROM  installed  at  any  one  time. could 
be  selected  from  a  library  of  such  ROM's  by  the  Commanding 
Officer,  depending  on  the  ship's  mission. 

The  filtered  outputs  of  the  contact  course  and  speed 
according  to  the  selected  scenario  were  plotted  on  Figure  8 
and  Fiture  9,  respectively.   As  is  noted  on  those  figures, 
the  Kalman  Filter  achieved  a  steady  state  condition  after 
four  to  seven  contact  position  measurements,  corresponding 
to  14.1  and  24.7  seconds  related  to  the  amount  of  reorienta- 
tion has  been  made  on  contact  course  and  speed.   Steady  state 
is  defined  as  the  condition  where  the  Kalman  Filter  Gain 

Matrix  (K  )  would  be  constant  for  contact  with  constant 
n 

relative  position  and  constant  sample  intervals. 
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The  bearing,  range,  course,  and  speed  of  contact  was 
computed  from  the  Kalman  filter's  optimal  estimate  of 
contact  state  and  compared  with  the  actual  contact  bearing, 
range,  course  and  speed.   Figures  10,  11,  12,  and  13  show 
plots  of  the  filtered  output  of  the  contact  bearing,  range, 
course  and  speed  errors,  respectively,  as  a  function  of 
the  time  interval  between  measurements. 

Several  conclusions  can  be  made  from  these  figures. 
First  of  all  the  Kalman  filter  initial  conditions  are 
very  much  affected  on  bringing  the  Kalman  filter  to  steady 
state  condition.   Any  information  about  contact  speed  would 
cause  to  shorten  the  time  spent  achieving  a  steady  state 
condition.   Also  selecting  the  variance  of  target  accelera- 
tion parameter  is  as  important  as  initiating  the  filter. 

The  value  of  the  variance  acceleration  parameter  0.0004 

2     2 
nm  /sec  were  chosen  after  many  trials  of  that  selected 

scenario.   It  should  be  noted  that  the  error  averages  for 

contact  are  a  function  of  the  elapsed  time  between  maneuvers 

and  the  time  spent  in  maneuver . 
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VI.   CONCLUSION 

A  microcomputer-based  tracking  system  has  been  developed 
that  eliminates  an  inaccurate  and  tedious  task  of  manual 
tracking,  for  any  ship,  without  the  expense  of  NTOS  size 
equipments,  with  digital  automatic  surface/subsurface  capa- 
bility. 

It  is  possible  to  obtain  optimal  estimates  of  contact 
position  and  velocity,  with  the  aid  of  the  4-state  Discrete 
Kalman  Filter  and  appropriate  conversions  for  polar  coordinate 
neasurements .   Thus  the  contact  course  and  speed  computations 
vere  successfully  performed  by  using  the  Intel  intellec  MOS 
nicrocomputer  system,  much  more  accurately  than  manual 
tracking  techniques. 

The  SBC-310  High  Speed  Mathematics  Unit  has  been  selected 
Dased  on  a  standard  floating-point  number  format  with  24 
oit  mantissa,  7  bit  exponent  and  a  sign  bit  by  comparing 
=xecution  times  of  procedures  to  perform  sufficient  accuracy 
to  reliably  compute  the  Kalman  Filter  Algorithms  and  con- 
version factors. 

The  total  average  of  the  system  execution  time  was 
approximately  50  msec  and  with  the  3.5  sec  sweep  of  an  AS- 
1161/SPS  radar  antenna,  a  single  system  could  continuously 
provide  bearing,  range,  course  and  speed  data  for  more  than 
fifty  contacts  by  modifying  the  software  program. 
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For  future  work  it  is  possible  that  the  system  could 
compute  a  contact's  closest  point  of  approach  (CPA)  and  could 
display  as  (1)  CPA  Bearing,  (2)  CPA  Range,  and  (3)  Time  of 
CPA  by  a  more  sophisticated  software  study. 

The  system  can  be  a  valuable  tool  aboard  non-NTOS  ships 
as  implemented.   A  microprocessor-based  system  such  as  the 
one  described,  has  the  potential  to  provide  any  ship  with  a 
digital  surface/subsurface  tracking  capability  without  the 
expense  of  NTOS  size  equipment.   It  can  reduce  the  manning 
of  underway  watches  while  improving  the  quality  of  the 
tactical  information  available  to  the  Officer  of  the  Deck. 
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APPENDIX  A 

Intel  SBC-310  High  Speed 
Mathematical  Unit  Descriptions 


A.  GENERAL  INFORMATION 

The  floating-point  package  developed  for  this  system  is 
based  on  the  SBC-310  High-Speed  Mathematics  Unit  fromlntel 
Corporation.   As  described  by  Reference  1,  the  SBC  310  Unit 
is  a  member  of  a  complete  line  of  the  Intel  SBC  8  0  System 
expansion  modules.   In  performing  high-speed  mathematical 
functions,  the  Math  Unit  acts  as  an  intelligent  processor 
slaved  to  one  or  more  SBC  80  Computer  Masters.   The  Mathe- 
matic  Unit  performs  its  repertoire  of  14  arithmetic  functions 
an  order  of  magnitude  faster  than  is  possible  with  software 
routines. 

B.  DESCRIPTION  OF  THE  MATH  UNIT 

The  Math  Unit  is  a  microprogrammed  processor  on  a  single 
board  and  is  designed  to  be  plugged  into  a  standard  SBC 
604/614  Modular  Backplane  and  cascade  to  interface  directly 
with  an  SBC  80  single  board  computer  or  to  be  used  with  an 
Intel  Intellec  Microcomputer  Development  System  (MDS) . 

The  Math  Unit  includes  the  following  standart  Intel  Series 
300  shotthy  bipolar  components:   3001  Microprogram  Control 
Unit  (MCU) ,  3002  Central  Processing  Element  (CPE) ,  3003  Look- 
Ahead  Carry  generator  (LCG) ,  and  3604  Electrically  Programmable 
Read  Only  Memory  (PROM) .   Also  included  are  pipe  line  register 
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and  bus  interface  logic.   The  pipeline  register  permits  the 
overlapping  of  microinstruction  fetch/execute  cycles  and  the 
bus  interface  logic  provides  compatibility  with  the  Intel 
Multibus. 

Standard  Operations  include  floating  point  add,  subtract, 
multiply,  divide  square  and  square  root;  fixed  point  integer 
multiply,  divide,  and  extended  divide;  conversion  between 
fixed  and  floating  point  representations;  and  test,  compare, 
and  argument  exchange  operations . 

The  Math  Unit  implements  unbiased  rounding  for  maximum 
accuracy.   Unbiased  rounding  is  the  same  as  ordinary  rounding 
unless  the  result  is  exactly  midway  between  two  floating 
point  numbers;  in  this  case  ordinary  rounding  always  increases 
the  result,  whereas  unbiased  rounding  rounds  the  result  to 
the  nearest  even  number.   When  a  calculation  is  performed 
that  results  in  either  an  exponent  underflow  or  overflow,  the 
Math  Unit  provides  exponent  wraparound  to  prevent  loss  of 
information. 

Operation  Codes  for  invoking  the  arithmetic  functions  are 
passed  to  the  Math  Unit  via  I/O  Write,  Commands,  which  are 
also  used  to  initialize  the  unit  with  a  memory  base  address. 
I/O  read  commands  are  used  to  determine  the  math  unit  status. 
Arguments  are  passed  to  the  Math  Unit  via  Memory  Write, 
Commands  and  the  results  are  obtained  via  Memory  Read  Commands. 

The  Math  Unit  which  can  be  operated  either  in  the  Inter- 
rupt of  Polled  mode,  generates  a  busy  signal  during  processing 
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operations  and  generates  either  a  complete  signal  or  an  Error 
signal  after  the  computation  is  complete.   The  information 
to  the  host  computer  which  these  three  signals  convey  is 
explained  in  Ref .  (1) . 

The  memory  base  address  and  I/O  base  address  are  user 
selectable.   The  16-bit  memory  address  is  completely  under 
software  control  and  is  assigned  by  the  host  processor  through 
a  sequence  of  I/O  Write  Commands,  addressed  to  the  Math  Unit. 
The  8  bit  I/O  base  address  is  selected  by  a  dual  inline 
package  (DIP)  switch  on  the  board. 

All  Math  Unit  operations  including  arithmetic  calculations, 
data  flow  between  functional  elements  on  the  board  bus  inter- 
face, and  associated  logical  tasks,  are  resident  microprogram 
permanently  stored  in  a  set  of  eight  Intel  3604  Erasable 
Programmable  Read  Only  Memory  CEPROM)  chips.   This  memory 
provides  1,024  micro-instructions  of  32  bits  each. 

C.   PREPARTION  FOR  USE 

1.   Installation  Consideration 

The  Math  Unit  is  designed  for  interface  with  an  Intel 
SBC  80  single  board  computer  based  system  or  an  Intel  Intellec 
Microcomputer  Development  System  (MDS) . 

When  installing  the  SBC  310  in  an  Intel  Intellec  MDS, 
the  CPU  board  needs  to  be  reconfigured  in  order  to  generate 
a  Qualified  Write  Signal;  this  reconfiguration  was  obtained 
by  considering  the  advanced  acknowledge  (AACK)  feature  by 
moving  a  jumper  labelled  "advanced  write"  from  a  D-C  connection 
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bo  an  E-D  connection  and  by  disabling  the  AACK/LINE  (pin  25) 
on   the  CPU  board  as  shown  in  the  schematic  diagram  on  page 
3-47  of  Reference  4. 

2.  I/O  Base  Address  Switches 

The  host  processor  transmits  control  information 
and  receives  status  information  from  the  Math  Unit  by  issuing 
C/0  Write  and  I/O  Read  Commands,  respectively.   The  I/O 
address  used  for  these  commands  is  relative  to  an  8-bit  base 
address  that  must  be  a  multiple  of  8.   This  base  address  is 
assigned  by  the  user  by  means  of  an  8-pole  dual  inline  package 
(DIP)  switch  assembly.   Five  of  the  eight  switch  poles  are 
:onnected  to  the  I/O  base  address  detection  logic;  the  other 
:hree  poles  are  unused. 

The  Math  Unit  had  used  its  DIP  switch  set  to  the 
C/0  base  address  of  1Q  hexadecimal  (only  switch  pole  no.  4 
*as  set  on) . 

3.  Programming  Information 

The  I/O  base  address,  which  must  be  assigned  by  switch 
selection  before  the  memory  base  address  can  be  assigned,  is 
lormally  performed  as  part  of  the  initial  installation  proce- 
lure.   This  switch  setting  allows  the  user  to  establish  a 
reference  or  base  to  the  ports  being  used  in  the  I/O  opera- 
tions; Table  7  shows  the  configuration  of  the  I/O  addressing 
as  it  was  set  in  the  system. 

The  memory  base  address,  which  is  software  controlled, 
Ls  assigned  by  a  sequence  of  two  I/O  Write  Commands.   The 
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I/O  PORT 
ADDRESS 

OUTPUT 

INPUT 

P  =  010H 

OP  CODE 

R 

P+l  =  011H 

MEM.  LOW 

STATUS  BYTE 

P+2  =  012H 

MEM.  HIGH 

R 

P+3  =  013H 

R 

R 

P+4  =  014H 

R 

R 

P+5  =  015H 

R 

R 

P+6  =  016H 

R 

R 

P+7  =  017H 

R 

FLAG  BYTE 

P:   I/O  BASE  ADDRESS 

R:   RESERVED 

OP  CODE:   MATHEMATIC  FUNCTION;  See  Table  4 

MEM.  LOW:   Memory  BASE  ADDRESS  (Lower  Byte) 

MEM.  HIGH:  Memory  BASE  ADDRESS  (Upper  Byte) 

Table  7.   I/O  ADDRESSING  OF  SBC-310  HIGH  SPEED  MATH  UNIT 
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first  command  is  addressed  to  port  (P+l)  and  loads  the  low 
order  byte  of  the  memory  base  address.   The  second  command  is 
addressed  to  port  (P+2)  and  loads  the  high  order  byte  of  the 
memory  base  address.   The  memory  base  address  must  be  a 
multiple  of  16;  i.e.,  the  lower  byte  must  be  in  the  form  XOH 
(X  is  any  hexadecimal  digit)  to  accommodate  the  16  required 
memory  locations  used  in  the  arithmetic  operations.   In  the 
system  developed  for  this  thesis  the  memory  base  address  was 
set  of  0F790H.   After  both  bytes  are  output,  the  memory  base 
address  (M)  is  established  and  need  not  be  reloaded  during 
any  subsequent  operations.   An  initialization  routine  for 
establishing  the  memory  base  address  was  designed  and  it  can 
be  seen  in  the  "INIT$FP"  procedure  in  the  floating  point 
module  (see  "FLOATING$PINT"  module  in  Appendix  F) . 
4.   Math  Unit  Functions 

The  Math  Unit  performs  floating  point  arithmetic, 
fixed-point  integer  arithmetic,  compare  and  test  operations, 
and,  float-to-fix  and  fix-to-float  conversions.   Operation 
Codes  and  execution  times  for  the  various  functions  are 
listed  in  Table  4.   Arithmetic  and  conversion  formats  are 
shown  in  Table  8. 

Beyond  the  functions  performed  by  the  Math  Unit, 
the  floating-point  package  was  designed  with  two  more  proce- 
dures which  compute  the  cosine  and  sine  of  a  given  angle  and 
the  arctangent  value  of  the  ratio  of  given  arguments. 
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SINGLE    PRECISION   FLOATING    POINT 


Mf3  M+2 

S7  0  22  16 


M+l  M 

15  8  7  0 


sign  binary  point       - 

"exponent  J  l  fraction 


8  bits 


23  bits 


where:  M:  Memory  Base  Address 

S:   "0"  =  positive;  "1"  =  negative 

E7-E0:  Biased  exponent;  Bias  =  07FH. 

F22-FO:  Fraction;  F  is  always  normalized 


FIXED  POINT  INTEGER 


M+l        M 
|5       37 Q 


binary  point 
where:  M:  Memory  Base  Address 

F15-F0:  16-bit  integer  (unsigned) 


M+3      M+2 
31     2423      16 


M+l 


M 


15. 


>A 


where:     M:     Memory  Base  Address 

F31-F0:     32-bit  integer    (unsigned) 


binary  point 


CONVERSION    FUNCTION 


M+3  M+2 

31  2423  16 


M+l  M 

15  8  7 


sign 

where:     M:  Memory  Base  Address 

S:  "0"  =  positive;    "1"  =  negative 

F30-F0:  two's  complement  integer 


binary  point 


Table    8.       ARITHMETIC   AND    CONVERSION    FORMATS    FOR 
SBC-10    HIGH    SPEED   MATH    UNIT 
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5.  Argument  and  Result  Data  Formats 

Argument  and  result  data  formats  and  memory  locations 
for  the  various  operations  are  presented  in  Table  9.   For  each 
argument  and  result,  this  table  includes  a  Format  number 
cross-referenced  to  one  of  the  four  formats  shown  in  Table  8 . 
Table  9  also  includes  the  OP  CODE  for  each  operation.   It  is 
important  to  note  that  the  result  of  an  operation  replaces 
the  first  argument  in  memory,  and  that  the  second  argument 
may  be  destroyed  in  the  course  of  the  computation,  these 
side  effects  were  avoided  in  the  floating-point  software 
design  by  saving  the  original  values  and  by  allowing  the 
user  the  possibility  of  having  one  of  the  operands  as  the 
result.   Error  conditions  for  each  operation  are  described 
in  the  next  paragraph. 

6.  Status  and  Flags 

The  Math  Unit  may  be  operated  in  the  interrupt  mode 
or  piled  mode. 

In  the  interrupt  mode,  the  Math  Unit  may  be  wire- 
wrapped  to  initiate  an  interrupt  request  under  one  or  both 
of  the  following  conditions: 

a.  Operation  Complete  without  an  error. 

b.  Operation  Complete  with  an  error. 

These  "completion"  signals  may  be  individually  wire- 
wrapped  to  separate  interrupt  lines  or  both  "completion" 
signals  may  be  wire-wrapped  to  the  same  interrupt  line  (Reference 
1). 
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OP 

OP 
CODE 

ARGUMENT 
FORMAT* 

ARGUMENTS** 

RESULT 
FORMAT* 

RESULT*** 

MUL 

0 

2 

2 

M,M+1 
M+4,M+5 

2A 

M,M+l,M+2,M+3 

DIV 

1 

1 
1 

M,M+1 
M+4,M+5 

2 

M,m+1  (remainder 
in  M+4,M+5) 

EDIV 

E 

2A 
2 

M,M+l/M+2,M+3 
M+4,M+5 

2 

M,M+l,M+2,M+3 
(remainder  in  M+l, 
M+5,M+6,M+7) 

FMUL 
FDIV 
FADD 
FSUB 

2 
3 
4 
5 

1 

M,M+l,M+2,M+3 
M+4,M+5,M+6,M+7 

1 

M,M+l,M+2,M+3 

FSQR 
FSQRT 

6 

7 

1 

M,M+l,M+2,M+3 

1 

M,M+l,M+2,M+3 

FLTDS 

8 

3 

M,M+l,M+2,M+3 

1 

M,M+l,M+2,M+3 

FLXSD 

9 

1 

M,M+l,M+2,M+3 

3 

M,M+l,M+2,M+3 

FCMPR 

A 

1 

M,M+l,M+2,M+3 
M+4,M+5,M+6,M+7 

- 

STATUS  Byte 

FZTST 

B 

1 

M,M+l,M+2,M+3 

- 

STATUS  Byte 

EXCH 

F 

Any 

M,M+l,M+2,M+3 
M+4,M+5,M+6,M+7 

- 

Rotates  both 
Arguments 

*Refer  to  appropriate  FORMAT  No  column  in  Table  8 

**Seoond  argument  is  always  the  operator,  and  may  be  destroyed 
during  operation. 

***Results  of  all  operations,  except  FIXSD  are  rounded,  FIXSD 
truncates  the  result. 

Table  9.   OPERATION  ARGUMENT  AND  RESULT  DATA  FORMATS  FOR 
SBC-10 
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In  the  polled  mode,  the  subroutine  designed  fo  ithis 
purpose  checks  both  the  status  byte  and  the  flag  byte  (Tables 
10  and  11) .   The  polled  mode  procedure  loops  on  testing  the 
busy  bit  until  the  busy  bit  is  clear  and  then  checks  the 
error  bits.   If  an  error  exists,  the  error  code  is  input  from 
the  Math  Unit  and  a  message  error  is  issued.   The  software 
has  developed  for  control  of  the  Math  Unit  if  the  system 
employs  the  polled  mode  described. 

As  mentioned  before,  the  condition  of  the  Math  Unit 
is  continuously  updated  and  stored.   The  flag  byte  shown  in 
Table  10  may  be  obtained  by  performing  an  I/O  Read  Command 
to  Pt  7  (Table  7) .   After  an  operation  is  completed,  the 
status  byte  may  be  obtained  by  performing  an  I/O  Read  Command 
to  P+L  (Table  7) . 

As  shown  in  Table  (11) ,  the  status  byte  indicates 
error  conditions  where  applicable  and  the  results  of  compare 
(FCMPR  procedure)  and  Test  (FZTST  procedure)  operations. 
Each  of  the  six  error  conditions  are  defined  as  follows; 

a.  Divide  by  Zero:   (001) 

This  error  condition  is  returned  by  either  "DIV" , 
"EDIV",  or  "FDIV"  procedures  to  indicate  that  an  attempt  was 
made  to  divide  by  zero. 

b.  Domain  Error  (010) 

This  error  condition  is  returned  by  the  "FSQRT" 
procedure  to  indicate  that  the  argument  was  not  in  the  domain 
of  the  function;  i.e.,  an  attempt  was  made  to  take  the  square 
root  of  a  negative  number. 


77 


7    6543    210 

R 

R 

R 

R 

R 

E 

C 

B* 

where: 

R  it 
B   ii 
C   is 
E   is 

5  reserved  for  future  use 

3  busy 

s  operation  complete  without  error 

3  operation  complete  with  error 

* 
when  8=1,  the  Math  Unit  is  busy  and  can  not 

respond  to  further  request  except  request  for 

flags . 

Table  10,   FLAG  BYTE  FORMAT  FOR  SBC-310 
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where 
R 

> 
< 


= 

> 

< 

R 

R 

ERR 

is  reserved  for  future  use 

is  equal  (for  FCMPR  and  FZTST) 

is  greater  than  (for  FCMPR  and  FZTST) 

is  less  than  (for  FCMPR  and  FZTST) 


ERR   is  a  3-bit  error  code  specifying  one  of 
the  following  error  conditions* 

QQO  No  error 

001  Divide  by  Zero 

010  Domain  Error 

Oil  Over  flow 

100  Under  flow 

1Q1  First  argument  invalid 

110  Second  argument  invalid 

111  Reserved 


Table  11.   STATUS  BYTE  FORMAT  FOR  SBC-310 
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c.  Overflow  (Oil) 

This  error  condition  is  returned  by  the  "FADD" , 
"FSUB",  "FMIL",  "FDIV",  "FSOR",  and  "FIXSD"  procedures.   In 
the  case  of  "FIXSD"  procedure,  this  error  indicates  that  the 
floating-point  number  is  too  large  to  be  converted  to  a  32 
bit  two's  complement  signed  integer.   If  an  overflow  error 
occurs  during  "FIXSD",  the  floating-point  argument  is  left 
unchaged  and  may  be  read  from  the  Math  Unit. 

In  all  other  cases,  this  error  condition  signifies 
that  the  exponent  of  the  result  is  too  large  to  be  repre- 
sented in  eight  bits.   In  this  case,  OBEH  is  subtracted  from 
the  resulting  exponent  (bringing  it  back  into  range  for  other 
computations  and  ensuring  a  valid  result) ,  and  the  lower 
eight  bits  of  the  exponent  are  returned  in  the  exponent  field 
of  the  result. 

d.  Underflow  (.100) 

This  error  condition  is  returned  by  "FAOO", 
"FSUB" ,  "FMUL" ,  "FDIV",  and  "FSQR"  procedures  to  indicate 
that  the  exponent  of  the  result  is  too  small  to  be  represented 
in  eight  bits.   In  this  case  OBEH  is  added  to  the  resulting 
exponent  bring  it  back  into  range  for  other  computations  and 
ensuring  a  valid  result,  and  the  lower  eight  bits  of  the 
exponent  are  returned  in  the  exponent  field  of  the  result. 

e.  First  Argument  Invalid  (101) 

This  error  condition  is  returned  by  the  "FADD", 
"FSUB",  "FMUL",  "FDIV",  "FSQR",  "FSQRT",  "FIXSD",  "FCMPR", 
and  "FZTST"  procedures  to  indicate  that  the  first  (or  only) 
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argument  for  the  specified  function  is  invalid.   The  second 
argument  (if  applicable)  is  not  checked  if  this  error  is 
encountered.   The  invalid  argument  is  left  unchanged  and 
may  be  read  from  the  Math  Unit. 

f.   Second  Argument  Invalid  (110) 

This  error  condition  is  returned  by  the  "FDD", 
"FSUB",  "FMUL",  "FDIV"  and  "FCMPR"  procedures  to  indicate 
that  the  second  argument  for  the  specified  function  is 
invalid.   This  error  condition  occurs  only  after  the  first 
argument  is  checked  and  found  valid.   The  invalid  argument 
is  left  unchanged  and  may  be  read  from  the  Math  Unit* 

Notes : 

(1)   The  floating-point  argument  may  be  expressed 
as: 


(1)  x  (2E  -  BIAS)  x  Cl.F) 


Notice  that  a  "1"  is  assumed  in  the  highest  position  of 
fraction. 

(2)   There  is  one  unique  representation  for  zero; 

S   =   0 

E7  -  E0   =   0 

F22  -  F0   =   0 
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(3)   The  following  representations  are  invalid. 

(a)  Assures  unique  representation  of  zero 

E7  -  EO   =   0  ,  and 

S  ?      0   or   F22  -  FO   =   0 

(b)  Reserved  for  future  enhancements 

E7  -  EO   =   OFFH 

7.   Examples  of  Floating-Point  Number^  Representations 

As  shown  in  Table  8  the  representation  of  a  floating- 
point number  has  one  particularity  that  needs  to  be  men- 
tioned; i.e. ,  a  "1"  is  always  assumed  in  the  highest  bit 
position,  and  then  it  yields  an  effective  24-bit  mantissa. 
For  the  sake  of  clarity  some  examples  are  given  in  Table  12. 
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F.P.  Number 

M 

M+l 

M+2 

M+3 

-  INFINITY 

.OFFH 

OFFH 

OFFH 

OFFH 

-  255.0 

OOH 

OOH 

07FH 

OC3H 

5.0 

OOH 

OOH 

OAOH 

OCOH 

1.0 

OOH 

OOH 

080H 

08FH 

0.0 

OOH 

OOH 

OOH 

OOH 

+    1.0 

OOH 

OOH 

080H 

03FH 

+    5.0 

OOH 

OOH 

OAOH 

04QH 

+  255.0 

OOH 

OOH 

07FH 

043H 

+  INFINITY 

OFFH 

OFFH 

OFFH 

07FH 

7T 

ODBH 

OOFH 

049H 

040H 

* 

OFFH 

OFFH 

07FH 

07FH 

** 

OOH 

OOH 

08  OH 

OOH 

1.07  xlO9  *** 

OFFH 

OFFH 

07FH 

04BH 

* 

This  is  the  largest  number  in  th 

floating-point  format. 

**  This  is  the  smallest  positive  nm 
precision  floating-point  format. 

***  This  is  the  largest  number  that 
to  floating  point  without  losing 

e  single-p] 

Tiber  in  th< 

can  be  com 
accuracy. 

recision 
5  single 
/erted 

Table  12.   FLOATING  POINT  NUMBERS 
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APPENDIX  B 
System  Start-Up  Procedure 


Caution:   Never  turn  on  or  off  the  diskette  drive  with 
a  diskette  inserted  ! ! I 


1.  TURN  ON  MDS  SYSTEM.  Use  the  key  located  at  the  upper 
left  corner  of  the  front  panel  and  turn  it  clockwise. 
The  power  indicator  should  light. 

2.  TURN  ON  DISKETTE  DRIVE.   Use  power  switch  located  at  the 
front  panel.   The  on  indicator  should  light. 

3.  TURN  ON  DATAMEDIA  TERMINAL  (CRT).   Use  switch  located 
on  right  side.   The  cursor  should  appear  at  the  screen 
after  a  few  seconds.   Ensure  that  the  lights  CD,  CTS, 
ROLL  and  FULL  DUPALLEX  are  on. 

4.  PLACE  SYSTEM  DISKETTE  IN  DIRVE  0  and  the  source  diskette 
in  drive  1,  with  the  read/write  access  slot  first.   Close 
door  of  the  drives  after  insertion. 

5.  BOOTSTRAP  THE  ISIS-II  OPERATING  SYSTEM. 

a.  Press  top  of  the  Intellec  BODY  Switch. 

b.  Press  top  of  the  RESET  Switch. 

c.  Observe  that  INTERRUPT  2  INDICATOR  goes  on  before 
proceding. 

d.  Press  space-bar  of  Datamedia  video  terminal  keyboard. 

e.  Observe  that  INTERRUPT  2  indicator  goes  off  before 
proceding. 

f.  Press  bottom  of  BOOT  Switch. 
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g.   Observe  that  the  following  message  appears  at  the 
Datamedia  Video  terminal  screen: 

ISIS-II,  V3.4 

6.  Issue  the  following  Command: 

-  :F1:  FATIH 

7.  After  a  few  seconds,  the  Datamedia  Video  terminal  screen 
will  show  the  first  computation  of  COURSE,  BEARING, 
RANGE,  SPEED,  THE  KALMAN  FILTER  GAIN  MATRIX  ELEMENTS,  AXX, 
AXY,  AYX,  AYY,  BXX,  BXT,  BTX,  BYY  and  the  FILTER  Error 
Performance  DELTA  RANGE,  DELTA  BEARING,  DELTA  RANGE  DOT, 
DELTA  BEARING  DOT  and  following  message  appears  at  the 
screen: 

NEXT  ?   CY/N) 

3.   PRESS  THE  LETTER  *  Y'  and  see  ^YES*  message  appear  on  the 
screen  to  compute  next  measurement. 
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APPENDIX  C 

AN/SPS-10  Search  Radar  Characteristics 
with  AS-1161/SPS  Radar  Antenna 


Peak  Power,  190  KW 

Antenna  Gain,  30  dB 

Pulse  Repetition  Rate  625  Hz 

Frequency  5825  MHz 

-5 

Propagation  Attenuation  0.6  x  10   dB/m 

Noise  Figure  22.9  dB 

Band  width  5  MHz 

Noise  Bandwidth  (1.05  x  B)  z      5.25  MHz 

System  tosses  5  dB 

Antenna  Rotation  Rate  17  rpm 

Antenna  Horizontal  Beamwidth  1.9° 
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APPENDIX  D 
Algebraic  Form  of  Discrete  Kalman  Filter 

1.   COVARIANCE  MATRIX  FOR  THE  OBSERVATION  NOISE 


o    (n)      a      (n) 
x  xy 

R 
n 

2  2 

a   (n)  '     a  (n) 
xy        y 


2         2.2         222 

a  (n)   =   a   •  sin  0 (n)  +  r  (n)  «aa  •  cos  0  (n) 
x         r  y 


2         2       2         2        2       2 

a  (n)   =   a   •  cos  0  (n)  +  r  (n)  *  aQ  •  sin  0  (n) 


2  1  2     2     2' 

a   (n)   =   j  *  sin  2e  (n)  *  tar  -  r  (n)aQ] 


2.   THE  GAIN  MATRIX 


K   =   P(n)  *  Hfc  -(H-P(ri)'HT  +  R  )  ~1 

n  n 


A   =   (Pu(n)  +a£(n))  (P33(n)  +ay(n)) 


-  (P31(n)  +  a^y(n))(P13(n)  +  ^y(n)) 


Axx(n)   =   [Pi;L(n)  (P33(n)+Oy(n))-P13(n)  (P31  (n)  +axy  (n)  )  J/A 
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Axy  (n)   =   [P13  (n)  (Pn  (n)  +  a^  (n)  )  -  P^  (n)  (P13  (n)  +  a^y  (n)  )  ]  /A 


Ayx(n)   =   [P31(n)  (P33(n)  +  ay(n))  -P33(n)  CP31  (n)  +  axy(n))]/A 


Ayy(n)   =   [P33(n)  (Pu(n)  +  a*(n))  -P31(n)  CP13  (n)  +  a*  (n))]/A 


Bxx(n)/T  =  [P21(n) (P33(n)+ay(n))-P23(n) (P31(n)+axy(n))]/A 


Bxy(n)/T  =  [P23(n) (P11(n)+ax(n))-P21(n) (P13(n)+axy(n))]/A 


Byx(n)/T  =  [P41(n)  (P33(n)+ay(n))-P43(n)  (P31Cn)+axy(n)]/A 


B   (n)/T  =  [P43(n)  (Pi;L(n)+ax(n))-P41(n)  (P13(n)+axy(n))]/A 


3.   THE  COVARIANCE  MATRIX  OF  ESTIMATION  ERROR  AFTER 
PROCESSING  THE  OBSERVATION 


P    =   (I  -K  H)  P 
n  n    n 


Pu(n)   =   PuCnXl-A^)  -P31tn)  Axy 


P12(n)   =   P12(n)(l-Axx)  -  P32(n)  Axy 


P,-,(n)   =   P.,(n)(l-A   )  -  P,,(n)  A 
13         13        xx     33     xy 


P,  „(n)   =   P,,(n)(l-A   )  -  P,„tn)  A 
14         14        xx     34     xy 


P~,  (n)   =   Pon  (n)  -  P.,  (n)  B   -  P.,  (n)  B 
21         21       11     xx    31     xy 


P22(n)   =  P22(n)  -  P12(n)  Bxx  -  P32  (n)  Bxy 


P23(n)   =  P23(n)  -  P13(n)  Bxx  -  P.3 (n)  Bxy 


P..(n)   =  P,.(n)  -  P,.(n)  B   -  P,„(n)  B 
24         24       14     xx    34     xy 


P31(n)   =  P31(n)(l-Ayy)  -  Pll(n)  Ayx 


P32(n)   =   P32(n)(l-Ayy)  -  P12(n)  Ayx 


PQO(n)   =  P-,(n)(l-A   )  -  P,-,(n)  A 
33         33        yy     13     yx 


P-,.  (n)   =   P,„  (n)  (1  -  A  .,)  -  P,  ,  (n)  A 
34         34        yy      14      yx 


P.,  (n)   =   P.,  (n)  -  P.,,  (n)  B   -  P0, (n)  B 
41         41       11     yx    31     yy 


P„n(n)   =  P,0(n)  -   P,~(n)  B   -  P-n  (n)  B 
42  42        12      yx     32      yy 


P,-,(n)   =   P,,(n)  -  P,-,(n)  B   -  P0-,(n)  B 
43         43       13     yx    33     yy 


P44(n) 


P„,(n)  -  P.  .  (n)  B    r  P.,,(n)  B 
44        14      yx     34      yy 
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4.   THE  COVARIANCE  MATRIX  OF  THE  ESTIMATION  ERRORS 
PRIOR  TO  PROCESSING  THE  OBSERVATION 


p(n+u     =    *  •  p     •  $T  +  r-Q-rT 

n 


Pi;L(n+l)      =      P11(n)    +    (P21(n)+P12(n))T+P22(n)T     +  aQT  /4 


P12(n+1)      =      P12(n)    +   P22Cn)T  +   °!t3/2 


P13(n+1)      =      P13(n)    +    (P23(n)  +P14(n)  )T  +  P24(n)T 


P14(n+1)      =      P14(n)    +   P24(n)T 


P21(n+1)      =      P21(n)    +  P22(n)T  +   aV/2 


P22(n+1)      =     P22(n)    +  aV 


P23(n+1)      =      P23(n)    +   P24(n)T 


P24(n+1)      =      P24(n) 


2 


P31(n+1)      =      P31(n)    +    (P41(n)  +P32(n))T  +   P42(n)T 


P32(n+1)      =      P32(n)    +  P42(n)T 


P33 (n+1)      =      P33 (n) + (P43 (n) +P34 (n) ) T+P44 (n) T2+a^T4/4 
P34(n+1)      =      P34(n)    +  P44(n)T  +   aV/2 
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P41(n+1)      =      P41Cn)    +  P42(n)T 


P42(n+1)      =      P42(n) 


P43(n+1) 


P43Cn)    +  P44(n)T  +   aV/2 


P44Cn+1) 


2    2 
P44(n)    +   aaT 
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